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Prufungsantrag gem. § 44 PatG ist gesteMt 

® Verfahren und Vorrichtung zur Bestimmung eines Bewegungsparameters eines Kraftfahrzeuges mit einem 
D-G PS-System 

(57) ErfindungsgemaB wird ein Verfahren bzw. eine Vorrich- 
tung zur Betimmung eines Bewegungsparameters eines 
Kraftfahrzeugs vorgeschlagen, wobei eine Steuerung (1} 
zur Bestimmung insbesondere des aktuellen Geschwin- 
digkeitsvektors und dem Winke! zwischen der Fahrzeug- 
langsachse und dem Geschwindigkeitsvektor (Schwimm- 
winkel) unter Hinzuziehung eines Differenz -Navigations- 
systems (D-GPS) berechnet wird. Da das Differenz-Navi- 
gationssystem (D-GPS) erheblich genauere Positionsda- 
ten liefertalsein in Kraftfahrzeugen eingesetztes "norma- 
les" Navigationssystem, kann auch die Bestimmung des 
Geschwindigkeitsvektors des Kraftfahrzeugs mitgroSerer 
Genauigkeit erfolgen. Dieses ist insbesondere auf glatter 
Fahrbahn, wenn das Kraftfahrzeug ins Schleudern gerat 
oder die MeBdaten des Radsensors nicht mehr zuverlas- 
sig sind, relevant sein. In weiterer Ausgestaltung der Er- 
findung ist vorgesehen, daft die vom Navigationssystem 
gelieferten Daten auch zur Kontrolle und Uberwachung 
der Sensordaten herangezogen werden. Bei Uberschrei- 
tung eines vorgegebenen Grenzwertes kann eine entspre- 
chende Fehlermeldung ausgegeben werden. 
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Beschrcibung 
Stand der Technik 

5 Die Erfindung geht aus von einem Verfahren zur Bestimmung eines Bewegungsparameters eines Kraftfahrzeugs nach 
der Gattung des Hauptanspruchs. Aus der DE 195 28 183 A 1 ist schon ein Fahrzeuggerat zur Ausweriung von empfan- 
genen Positionssignalen von wenigstens einem Sender bekannt. Bei diesem Fahrzeuggerat werden beispielsweise von 
dem Satellitensystem GPS Zeitsignale empfangen und daraus die Positionsdaten fiir diverse Bewegungsparameter des 
Fahrzeugs, beispielsweise die Fahrgeschwindigkeit, Beschlcunigung, Anderung von Dreh- und Richtungswinkeln be- 
10 rechnet. Mit diesen Bewegungsparametern werden Vorrichtungen fur das Fahrzeug odcr den Motor gesteuert. Beispiels- 
weise kann aus dem ermittelten Geschwindigkeitssignal ein ABS-Bremssystem oder ein Fahrgeschwindigkeitsbegrenzer 
gesteuert werden. 

Ungiinstig erscheint jedoch, daB die Positionsberechnung des Fahrzeugs aus den Signalen des Satellitensy stems rela- 
tiv ungenau ist, so daB die daraus ermittelten Bewegungsparameter eine groBe Fehlertoleranz aufweisen konnen. Insbe- 

15 sondere konnen Drehwinkel um die Hochachse nicht mit hinreichendcr Genauigkeit berechnet werden. Dieses ist jedoch 
erforderlich, wenn das Fahrzeug insbesondere bei schlupfriger und glatter Fahrbahn anfangt, ins Schleudern zu geraten. 
Denn nur bei einer fruhzeitigen Erkennung eines Drehwinkels, insbesondere des Schwimmwinkels (Winkel zwischen 
der Fahrzeuglangsachse und dem Geschwindigkeitsvektor des Fahrzeugs) kann eine entsprechende Steuerung oder Re- 
gelung ein Ausbrechen des Fahrzeugs verhindem. 

20 Des wciteren sind grundsatzliche Oberlegungen zur Regelung der Giergeschwindigkeit in Abhangigkeit vom Lenk- 
winkel und der Fahrgeschwindigkeit - wobei auch der Fahrzeugschwimm winkel berucksichtigt wird - aus der Veroffent- 
lichung *FDR - Die Fahrdynamikregelung von Bosch", Anton von Zanten, Rainer Erhardt und Gcorg Pfaff, ATZ - Auto- 
mobiltechnische Zeitschrift 96 (1994) 11, Seiten 674 bis 689, bekannt. In dieser Veroffentlichung werden zunachst theo- 
retische Zusammenhange zwischen dem Ist-Verhalten eines Kraftfahrzeugs unter Beriicksichtigung der Giergeschwin- 

25 digkeit und des Schwimmwinkels dargestellt und anschlieBend anhand eines Steuergerates naher erlautert. Zur Erfassung 
des Lenkwinkels, der Fahrzeuggeschwindigkeit und der Giergeschwindigkeit bei einer Kurvenfahrt werden entspre- 
chende Sensoren verwendet, die sich am Fahrzeug befinden. Hinweise zur Verwendung von Positionssignalen, die von 
einem Satellitensystem iibertragen werden, sind dieser Veroffentlichung jedoch nicht entnebmbar. 

30 Vorteile der Erfindung 

Das erfindungsgemaBe Verfahren bzw. die Vorrichtung zur Bestimmung eines Bewegungsparameters eines Kraftfahr- 
zeugs mit den kennzeichnenden Merkmalen der nebengeordneten Anspriichen 1 und 6 hat demgegeniiber den \brteil, 
daB durch die Verwendung des Differcnz-Positions-Satellitensystems, vorzugsweise des D-GPS-Systems, der augen- 

35 blickliche Geschwindigkeitsvektor fur das Krafitfahrzeug mit seiner exakten Lage im globalen Koordinatensystem sehr 
genau bestimmt werden kann. Die Bestimmung des Geschwindigkeitsvektors aus Signalen von Radsensoren ist zu un- 
zuverlassig, da beispielsweise bei glatter Fahrbahn die Radgeschwindigkeit infoige eines Bremseingriffes verfalscht 
wird. Hier hilft in vorteilhafter Weise eine Positions- und Geschwindigkeitsberechnung aus den Signalen des D-GPS-Sy- 
stems. Die Praxis hat gezeigt, daB eine Positionsbestimmung mit einem D-GPS- System bis auf weniger als ein Meter ge- 

40 nau sein kann. Dies ist eine groBe Verbesserung gegeniiber dem bekannten GPS-System (Global-Position-System), bei 
dem Toleranzen von 100 m oder mehr moglich sind. 

Durch die in den abhangigen Anspriichen aufgefuhrten MaBnahmen sind vorteilhafte Weiterbildungen und Verbesse- 
rungen des im Hauptanspruch angegebenen Verfahrens bzw. der Vorrichtung moglich. Besonders vorteilhaft ist, daB die 
Berechnung des Schwimmwinkels und/oder des Geschwindigkeitsvektors zur Regelung der Giergeschwindigkeit des 

45 Kraftfahrzeugs verwendet wird. Insbesondere kann ein entsprechendes Gerat zur Fahrdynamikregelung (FDR) bei friih- 
zeitigem Eingriff, beispielsweise durch Bremsen des entsprechenden Rades die Giergeschwindigkeit kompensieren und 
somit ein Schwimmen und AuBer-Kontrolle-Geraten des Fahrzeugs wirkungsvoll verhindern. 

Als besonders vorteilhaft wird weitcr angesehen, daB die vom D-GPS-System ermittelten Bewegungsparameter dazu 
benutzt werden konnen, die Daten der Fahrzeugsensoren zu kontrollieren oder auch zu korrigieren. Dies erfolgt insbe- 

50 sondere in solchen Phascn, wenn beispielsweise das Fahrzeug in normaler Fahrt auf einer geraden Strecke fahrt. Die Da- 
ten eines Gierratensensors konnen beispielsweise bei einer normalen Kurvenfahrt ermittelt werden. 

Als besonders vorteilhaft wird angesehen, daB bei Uberschreiten einer vorgegebenen Schwelle fur die Differenz aus 
den Satellitensignalen und den Sensorsignalen ermittelten Parameterwerte eine Warnmeldung an den Fahrer ausgegeben 
wird. Aufgrund der Warnung erkennt der Fahrer, daB beispielsweise die Vorrichtung fiir die Fahrdynamikregelung feh- 

55 lerhaft ist. Er hat somit die Moglichkeit, rechlzeitig eine Werkstatt aufzusuchen, um sein Fahrzeug uberpriifen zu lassen. 

Zeichnung 

Ein Ausfuhrungsbeispiel der Erfindung ist in der Zeichnung dargestellt und in der nachfolgenden Beschrcibung naher 
60 erlautert. Fig. 1 zeigt ein Blockschaltbild, Fig. 2 und 3 zeigen Diagramme in einem globalen Koordinatensystem, Fig. 4 
zeigt ein drittes Diagramm, und Fig. 5 zeigt eine Tabelle. 

Beschreibung des Ausfiihrungsbeispiels 

65 Das Blockschaltbild der Fig. 1 zeigt eine Steuerung 1, die iiber einen entsprechenden Eingang mit einem Navigations- 
system 2 verbunden ist, das als Differenz-Navigationssystem (D-GPS, Global Positioning System) ausgebildet ist. Das 
D-GPS-System 2 liefert zeilabhangige Daten fur die Positionsbestimmung des Kraftfahrzeugs in einem globalen Koor- 
dinatensystem x(t), y(t). Dcsweiteren ist an die Steuerung 1 ein Sensor 4 angeschlosscn, der beispielsweise als Raddreh- 
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zahlfuhler die Gcschwindigkeit dcs Fahrzcugs erfafit. Weitere Sensoren wie Lcnkwinkel-, Drchraten-, Qucrbeschleuni- 
gungs- und/oder Federwegsensor sind vorsehbar. Ausgangsseitig ist die Steuerung 1 mit einem Steuergerat 3 verbunden, 
das beispielsweise zur Fahrdynamikregelung (FDR, ESP) dient. In alternativer Ausgestaltung der Erfindung ist vorgese- 
hen, daB das Steuergerat 3 mit dem Sensor 4 verbunden ist und dessen Daten vorzugsweise in aufgeschliisselter Form an 
die Steuerung 1 liefert. Dieses konnen Daten iiber die Fahrzeuggeschwindigkeit v(t) oder den Lenkwinkel w(t) sein. An- 5 
dererseits liefert die Steuerung 1 aufbereitete Daten iiber die Fahrzeug-Ist-Geschwindigkeit oder den Schwimmwinkel 
b(t). Als Schwimmwinkel wird der Winkel verstanden, der zwischen der Fahrzeuglangsachse 1 und dem Geschwindig- 
keitsvektor V gebildet wird. Dieser Zusammenhang ist in Fig. 2 naher erlautert. 

Das Diagramm der Fig. 2 zeigt ein globales x, y-Koordinatensystem, in dem die Bewegung des Fahrzeugs 10 durch 
drei ZustandsgroBen bcschrieben wird. Demnach laBt sich die Position des Fahrzeugschwerpunktes S durch den \fektor a 10 
beschreiben. Der Geschwindigkeitsvektor V greift im Fahrzeugschwerpunkt S an und zeigt in die Bewegungsrichtung 
des Fahrzeuges. Als dritte GrdBe ist der Schwimmwinkel b(t) zwischen der Fahrzeuglangsachse 1 und dem Geschwin- 
digkeitsvektor V zu nennen. Der D-GPS-Empfanger sollte vorzugsweise in der Nahe des Schwerpunktes S angeordnet 
sein. In der Praxis wird dies nicht immer moglich sein. Es muB daher bei der Positionsbestimmung ein entsprechender 
Offsetwert zur Korrektur berucksichtigt wcrden. 15 

Fig. 3 zeigt die MeBgroBen, die zur Bestimmung der FahrzeugzustandsgroBen, insbesondere der Position des Fahr- 
zeugschwerpunktes S, die aus Daten des D-GPS-Systems 2 bestimmt wird, die Drehrate w des Kraftfahrzeugs 10, die 
von dem Sensor 4, beispielsweise einem Drehraten- oder Gierratensensor 5 geliefert wird. Alternativ kann diese Infor- 
mation auch von einem entsprechenden Steuergerat 3 zur Fahrdynamikregelung geliefert werden. Desweiteren wird fur 
Abgleich- und Stiitzungsaufgaben die Radgeschwindigkeit oder Raddrehzahl vorzugsweise von einem Raddrehzahlsen- 20 
sor geliefert. Der Drehratensensor 5 gibt die Drehrate w oder den Drehwinkel in Abhangigkeit von der Fahrgeschwin- 
digkeit oder der zuriickgelegten Fahrstrecke an. Alternativ ist auch die Verwendung eines entsprechenden Lenkwinkel- 
sensors moglich. 

Als weiterer Parameter wird die Komponente der Fahrzeuggeschwindigkeit in 1-Richtung abgeschatzt. Diese wird aus 
einer Referenz-Geschwindigkeit gebildet, die das Steuergerat 3 aus den Daten des Raddrehzahlsensors und gegebenen- 25 
falls weiterer Daten liefert, beispielsweise von Motormanagement-Daten. Dieser Parameter wird wie eine MeBgroBe be- 
handelt und nachfolgend naher erlautert. 

Anhand der Fig. 4 wird die Bewegung des Fahrzeuges 10 von einem Zeitpunkt to bis zum Zeitpunkt t! naher erlautert. 
Das x/y-Koordinatensystem zeigt die Lage des Schwerpunktes S 0 zum Zeitpunkt to, beziehungsweise Si zum Zeitpunkt 
ti mit den entsprechenden Geschwindigkeitsvektoren 30 

v(to)bzw. v(t!) 

und den Schwimmwinkeln b(to) beziehungsweise b(t L ). In dieser Zeit andert sich die Lage des Schwerpunktes von S 0 auf 
S i, die vektoriell durch den Vektor a(to) bzw. a(ti) und der Winkelanderung Act beschrieben ist. Die Fahrzeugachsen an- 35 
dem sich entsprechend von 1, q in 1*, q\ 

Aus dieser Koordinatendarstellung lassen sich nun die Gleichungen fur die Geschwindigkeit des Fahrzeugschwer- 
punktes S wie folgt ableiten. Aus der zeitlichen Ableitung des vom D-GPS-Systems gelieferten Ortsvektors ergibt sich 
fur das Fahrzeug 10 der Geschwindigkeitsvektor 

v = — 
dt 



{Gleichung 1) . 

Damit laBt sich der Schwimmwinkel b iiber die Beziehung 

(Gleichung 2) . 

cos 6 = -3- 
M 

berechnen. 

Da die vom Steuergerat 3 gelieferte Referenzgeschwindigkeit allerdings in manchen Situationen, beispielsweise bei 
Glatteis, nicht verlaBlich ist, kann der Schwimmwinkel b entsprechend der Fig. 4 wie folgt berechnet werden. Das Fahr- 
zeug startet mit einem Schwimmwinkel von b = 0°. Die Anderung des Schwimmwinkels Ab mit der Zeit kann iiber fol- 
gende Beziehung bestimmt werden: 

A& = fc(/l)-fc(/ 0 ) = Ar-Aa 

(Gleichung 3) 

Dabei bedeutet 
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A/ = jco(T)dr 

to 

5 

(Gleichung 4) 
Als Integration des Drehrat en signals w des Drehratensensors und 
10 Act = ct(ti) - a(to) 
mit 

X',) 
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50 



tana(r,) = 



(Gleichung 5) 



Die Berechnung in Gleichung 2 kann zum Abgleich von Ay in Gleichung 3 wahrend unkritischer Fahrzustande ver- 
20 wendet werden, da das Signal des Drehratensensors in der Regel mit einem Offset beaufschlagt ist, der durch das Integral 
in Gleichung 4 immer weiter aufsummiert wurde. 

Damit kann eine Stutzung der Referenzgeschwindigkeit des Fahrzeugs uber die Gleichung 



v/ = |v|cos£> 



(Gleichung 6) 



nur stattfinden, wenn ein kritischer Fahrzustand herrscht, was allerdings auch nur in diesem Fall notwendig ist. Die ein- 
zelnen Bedingungen fur einen kritischen Fahrzustand sind durch den Sensor- und Reifentoleranzabgleich vorgegeben 

30 und bereits in dem Steuergerat 3 beriicksichtigt, 

Tabelle 5 zeigt zusammenfassend den Zusammenhang zwischen der Fahrzeug-Referenzgeschwindigkeit und dem 
Schwimmwinkel bei einem kritischen und einem normalen Fahrzustand. 

Bezugnehmend auf das Ausfuhrungsbeispiel der Fig. 1 liefert das D-GPS-System 2 die zeitlich veranderlichen Koor- 
dinaten x(t) und y(t) im globalen Koordinatensystem an die Steuerung 1. Diese erhalt von dem Sensor 4 die aktuelle 

35 Drehrate w(t), sowie die Referenzgeschwindigkeit v(t), Diese Werte konnen auch von einem entsprechenden Steuergerat 
3 geliefert werden. Aus diesen Werten errechnet die Steuerung 1 den aktuellen Schwimmwinkel b(t) und die neue Refe- 
renzgeschwindigkeit v*(t). Diese stehen dem Steuergerat 3 zur weiteren Verwendung zur Verfugung. Ist das Steuergerat 
3 als Fahrdynamiksteuergerat ausgebildet (FDR, ESP), dann konnen diese Werte insbesondere zur Korrektur des aktuel- 
len Schwimmwinkels b(t), d. h. zur Stabilisierung des momentanen Fahrzustandes des Kraft fahrzeugs 10 verwendet wer- 

40 den. 

In altemativer Ausgestaltung der Erfindung ist vorgesehen, dafi die vom Navigationssystem gelieferten Daten fur die 
Positionsbestimmung ebenfalls herangezogen werden, um die vom Sensor 4, beziehungsweise vom Steuergerat 3 gelie- 
ferten Parameter zu kontrollieren. So kann bei wiederholter Bestimmung der Fahrzeugposition auf der Basis der Navi- 
gationsdaten auch der vom Fahrzeug zuriickgelegte Fahrweg, der vom Sensor 4, beziehungsweise dem Steuergerat 3 er- 
45 mittelt wurde, mit den von dem Satellitensystem gelieferten Daten verglichen werden. Entsprechendes gilt fur die Fahr- 
geschwindigkeit sowie fur die Winkelbestimmungen aus den Werten des Drehratensensors. tjberschreitet die Differenz, 
die aus den Satellitendaten und den Sensordaten ermittelt wurde, einen vorgegebenen Schwellwert, dann kann dieses ein 
Hinweis fur einen Fehler scin. In diesem Fall wird vorzugsweise eine Meldung an den Fahrer ausgegeben, so daB der 
Fahrer sein Fahrzeug zur Uberpriifung in eine Werkstatt geben kann. 



Patentanspriiche 



1 . Verfahren zur Bestimmung eines Bewegungsparameters eines Kraftfahrzeugs (10), wobei wenigstens ein Sensor 
(4), beispielsweise ein Geschwindigkeits-, ein Lenkwinkel-, ein Drehraten-, ein Querbeschleunigungs-, ein Feder- 

55 wegsensor und/oder ein Satellitensystem Daten an eine Steuerung (1) des Kraftfahrzeugs (10) sendet und diese aus 

den empfangenen Daten den Geschwindigkeitsvektor und seine Lage nach einem vorgegebenen Algorithmus be- 
rcchnet, dadurch gekennzeichnet, daB das Navigationssystem ein Differenz-Positions-Satcllitensystem (D-GPS- 
System) ist, das Daten an die Steuerung (1) sendete und daB die Steuerung (1) aus den empfangenen Daten des we- 
nigstens einen Sensors (4) und des D-GPS-Systems (2) die exakten Positionskoordinaten fur den Fahrzeugschwer- 

60 punkt im globalen Koordinatensystem, den augenblicklichen Geschwindigkeitsvektor und/oder seinen Schwimm- 

winkel berechnet. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB die Steuerung (1) den Schwimmwinkel und/oder den 
Geschwindigkeitsvektor zur Regelung der Giergeschwindigkeit des Kraftfahrzeugs (10) verwendet. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, daB der Geschwindigkeitsvektor und/oder der 
65 Schwimmwinkel fJ(t) in einem Gerat (3) zur Fahrdynamikregelung (FDR, ESP) verwendet. 

4. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB die Steuerung (1) aus wie- 
derholt empfangenen Signalen des D-GPS-Systems die Bewegungsparameler berechnet und diese mil den berech- 
nctcn Daten vcrgleicht, die von dem wenigstens einen Sensor (4) geliefert wurden. 
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5. Verfahren nach Anspruch 4, dadurch gekennzcichnct, daB die Steuerung (1) bci Oberschreiten eines vorgegcbc- 
nen Schwellwertes fur die Differenz der aus den Satellitensignalen und den Sensordaten berechneten Parameter- 
werte eine Warnmeldung an den Fahrer ausgibt. 

6. Vorrichtung zur Durchfuhrung des Verfahrens nach einem der vorhergehenden Anspruche, dadurch gekenn- 
zeichnet, daB die Vorrichtung eine Steuerung (1) aufweist, an die Daten von einem Sensor (4) und/oder einem Steu- 
ergerat (3) sowie einem Differenz-Positions-SateLlitensystem (D-GPS-System, 2) geliefert werden und daB die 
Steuerung (1) ausgebildet ist aus den empfangenen Daten, den aktuellen Geschwindigkeitsvektor und/oder den 
Schwimmwinkel zu berechnen. 
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